ROBOT APPARATUS, AND LOAD ABSORBING APPARATUS AND METHOD 

BACKGROUND OF THE INVENTION 
FIELD OF THE INVENTION 

This invention relates to a robot apparatus f and a load 
absorbing apparatus and method for absorbing load applied to a 
motor, and specifically, to a robot apparatus, and a load 
absorbing apparatus and method for motors which are used as 
actuators for joint motion of a multi- joint type robot. 

For more detail, this invention relates to a robot apparatus, 
and a load absorbing apparatus and method for appropriately 
detecting and controlling overload which is applied to a motor and 
may break the motor or deform the body of the robot apparatus, and 
more specifically, to a robot apparatus , and a load absorbing 
apparatus and method, which are applied to a multi-joint type 
robot comprising a plurality of actuator motors in order to 
prevent breakage of members and the body due to overload applied 
to the motors having a single or multiple axes. 

DESCRIPTION OF THE RELATED ART 

"Robot" is a mechanical apparatus which performs like human 
beings, with electrical or magnetic functions. This term "robot" 
is said to be originated from "ROBOTA (slave machine)" in Slavic. 
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In Japan, robots were started to be spread in the late 1960s, and 
many of them were industrial robots such as manipulators and 
carrier robots for automated and unmanned factories. However, 
recent development relating to two-legged walking robot have been 
highly expected to be put to practical use. Specifically, the 
two-legged walking robot which is modeled after human motion is 
called humanoid robot. 

As compared with crawler, four-leg, or six-leg type robots, 
two-leg type robot is unstable when moving, and its posture and 
walking are hard to be controlled. However, the two-leg type 
robot is capable of waking on uneven floors and going up and down 
steps and ladders, which is an advantage. 

This kind of two-legged walking robot generally has a degree 
of freedom in many joints and these joints are moved by actuator 
motors. That is, a motor's output shaft is connected to one end 
of a link composing a part such as an arm or a leg, via a 
reduction gear, and the other end of the link is connected to a 
motor for next- joint motion. In order to realize desired 
performance and postures, servo control is performed based on the 
rotational position and rotational amount of each motor. 

In general, a servo motor is used for realizing a degree of 
freedom in a joint of a robot, because it is easy to use, it is 
compact and has high torque, and it is superior in response. 
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Specifically, an AC servo motor is brushless and maintenance free, 
so that it can be applied to an automated machine which is desired 
to work in unmanned working space, for example, to a joint 
actuator of a legged robot which walks freely. With a rotor 
comprising a permanent magnet and a stator consisting of multi- 
phase (for example, three-phase) coil windings, the rotor of the 
AC servo motor produces rotary torque with a sine wave flux 
distribution and a sine wave current. 

Advanced two-legged walking robot autonomously walks and 
moves. In addition, this robot is capable of standing up from a 
lying position and holding and carrying objects with its arms. On 
the other hand, overload may be applied to its joint actuators 
when it falls down, bumps against something, and gets something 
into its body. 

Such overload may cause fatal damage, for example, breakage 
or plastic deformation of its body. Therefore, what is crucial is 
that each motor constituting a joint actuator is provided with a 
mechanism for absorbing load. 

Fig. 1 shows a simple robot model. That is, the robot 
drives a motor 12 0 under the control of a higher-ranked controller 
not shown, and gives output torque to a link 122 via a gear 121, 
so as to move a movable part. 

In this figure, a torque limiter is provided between the 
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gear 121 and the link 122, in order to absorb shocks to be given 
from the outside to the link 122, thereby being capable of 
previously preventing breakage of the motor 120 and so on, caused 
by the shocks, such as deformation of the output shaft of the 
motor 12 0. 

Various kinds of torque limiters (or servo savers) have been 
proposed (for example, refer to Japanese Patent Laid Open No. 60- 
192893). Fig. 2 shows one example of the torque limiters. 

In a torque limiter 130 of this figure, first and second 
semicircular friction plates 132A and 132B are arranged inside a 
ring 131 fixed to a link 135. These first and second friction 
plates 132A and 132B are fixed to the output shaft 134 of a motor 
via elastic material 133 such as rubber or compression coil 
springs and are pressed against the ring 131 by a fixed pressure 
caused by the elastic material 133. 

In this torque limiter 130, the ring 131 can be generally 
rotated together with the output shaft 134 of the motor by 
frictional force generated between the first and second friction 
plates 132A and 132B and the ring 131. However, when load greater 
than static friction force between the first and second friction 
plates 132A and 132B and the ring 131 is applied to the ring 131 
due to a shock applied to the rink 135, the ring 131 and the first 
and second friction plates 132A and 132B slip on each other, so as 
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not to cause load greater than kinetic friction force between the 
ring 131 and the first and second friction plates 132A and 132B, 
in the output shaft 134 of the motor. 

This conventional torque limiter 130, however, has a problem 
in that static friction coefficients between the ring 131 and the 
first and second friction plates 132A and 132B vary easily and 
widely, so that it is difficult to determine an allowable margin 
at the time of designing a robot. 

Further, in the conventional torque limiter 130, the static 
friction coefficients between the ring 131 and the first and 
second friction plates 132A and 132B vary easily depending on 
temperature, which is also a problem. 

Furthermore, since the conventional torque limiter 130 is 
constructed mechanically as described above, it is hard to 
construct a smaller and lighter torque limiter and to therefore 
realize a smaller and lighter robot which contains motors. 

SUMMARY OF THE INVENTION 

In view of the foregoing, an object of this invention is to 
provide an advanced robot , apparatus , and a load absorbing 
apparatus and method for motors which are used as actuators for 
joint motion of a multi- joint type robot. 

An additional object of this invention is to provide an 
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advanced robot apparatus, and a load absorbing apparatus and 
method, which are capable of appropriately detecting overload 
which may break a motor and deform the body, and reducing the 
overload in the motor. 

An additional object of this invention is to provide an 
advanced robot apparatus, and load absorbing apparatus and method, 
which are capable of appropriately preventing breakage of members 
and the body due to overload applied to motors having a single or 
multiple axes, in a multi-joint type robot comprising a plurality 
of actuator motors . 

As the first aspect, the foregoing objects and other objects 
of the invention have been achieved by a robot apparatus having a 
plurality of movable joints, the robot apparatus comprising a 
plurality of motors for driving the joints, a plurality of first 
overload detection means for detecting overload in the 
corresponding motor, a load absorbing control means for, when any 
of the first overload detection means detects the overload in the 
corresponding motor, controlling a process to absorb the overload 
in the motor, a second overload detection means for determining 
whether loads in two or more motors are totally excessive, and a 
body protection control means for, when the second overload 
detection means detects the totally overload, carrying out a 
prescribed body protection operation. 
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Multi-joint type robot including two-legged walking robot is 
constructed by a plurality of motors for joint actuators and links 
connected to the output shafts of the motors . In this 
construction, it may happen that loads in the plurality of motors 
are totally excessive even the load in each motor is not excessive. 
For this case, it is considered that a body protection operation 
for removing the overload state from the entire body is required, 
separately from a load absorbing operation for each motor. 

In the robot apparatus of the first aspect of this invention, 
the second overload detection means is provided so that it is 
detected whether any part such as an arm or a leg, or the entire 
body is in an overload state even each motor is not in an overload 
state. When loads in a plurality of motors are totally excessive, 
not the load absorbing operation for each motor but the body 
protection operation is carried out. 

The body protection operation here includes cutoff of power 
to relevant motors or all motors of the body and weakening of the 
relevant motors or all motors of the body. The weakening of a 
motor is realized by setting its generated torque to zero or 
decreasing its viscosity resistance by servo gain adjustment. 

Further, as a second aspect, a load absorbing apparatus for 
absorbing load applied to a motor comprises a torque measuring 
means for measuring a load torque based on the sum of absolute 



7 



values of a torque applied to a link connected to the output shaft 
of the motor and the generated torque of the motor, an overload 
detection means for determining that overload has been applied 
when the load torque detected by the torque measuring means 
exceeds a first threshold value for a prescribed period of time or 
longer, and a load absorbing control means for absorbing the 
overload in the motor when the overload detection means detects 
the overload. 

Still further, as a third aspect of this invention, a load 
absorbing apparatus for absorbing load applied to a motor 
comprises a kinetic energy measuring means for measuring kinetic 
energy given to the output shaft of the motor, an overload 
detection means for determining that overload will be applied when 
the variation of the kinetic energy measured by the kinetic energy 
measuring means exceeds a second threshold value, and a load 
absorbing control means for avoiding the overload in the motor 
when the overload detection means detects the overload. 

Still further, as a fourth aspect of this invention, a load 
absorbing apparatus for absorbing load applied to a motor 
comprises a torque measuring means for measuring a load torque 
based on the sum of absolute values of a torque applied to a link 
connected to the output shaft of the motor and a generated torque 
of the motor, a kinetic energy variation measuring means for 
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measuring the variation of kinetic energy given to the output 
shaft of the motor, an overload detection means for detecting 
overload based on the load torque measured by the torque measuring 
means and the variation of kinetic energy measured by the kinetic 
energy variation measuring means, and a load absorbing control 
means for absorbing the overload in the motor when the overload 
detection means detects the overload. 

Multi-joint type robot including two-legged walking robot is 
generally constructed by a plurality of motors for joint actuators, 
and links connected to the output shafts of the motors. Now, 
assume that overload is applied to motors of the joint actuators 
when the robot falls down, dumps into something, or gets something 
into the body while walking or moving. The overload may cause 
fatal damage such as breakage or plastic deformation of the body 
(breakage of a link, dropout of a teeth of a reduction gear) . 

Load torque to be applied to a motor for a joint actuator is 
broadly classified into impulsive "shock load" which incurs 
distortion energy and may break members such as links, due to 
bumping or the like and "constant load" which is relatively high 
load torque, although not so high as the shock load, and is 
constantly applied for a prescribed period of time or longer and 
thereby causes plastic deformation. The inventors of this 
invention position the shock load and the constant load as AC 
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component and DC component, respectively. 

According to the second aspect of this invention, constant 
load, that is, the DC component of the load torque is detected 
based on the sum of absolute values of the torque to be applied to 
a link connected to the output shaft of the motor and the 
generated torque of the motor, and then it is recognized that the 
DC component of the load is excessive when the load torque exceeds 
the first threshold value for a prescribed period of time or 
longer. Since motor torque is in proportion to motor conducting 
current, the torque can be measured by converting motor current 
into a voltage. 

The first threshold value here is a value around the stall 
torque of the motor being used or a threshold value such as a 
limitation for circuit protection. 

Then, in order to avoid the breakage due to the constant 
load, a prescribed load absorbing operation can be carried out, 
for example, the generated torque of the motor is reduced or the 
viscosity coefficient of the motor is decreased. Such load 
absorbing apparatus realizes a small variation of motor viscosity 
coefficients among parts and further is lightly affected by 
temperature. In addition, the torque detection can be carried out 
by a simple process, which can realize a smaller and lighter robot 
apparatus even it contains motors . 
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Further, according to the third aspect of this invention, a 
load torque is detected based on the variation of kinetic energy, 
considering such characteristic that the variation of kinetic 
energy given to the output shaft of a motor is in proportion to a 
product of a torque applied to the motor and its angular velocity, 
and then it can be predicted that the AC component of the load 
will be excessive when the load torque exceeds the second 
threshold value which may break members. 

Then, in order to avoid breakage due to the shock load, a 
prescribed load absorbing operation can be carried out, for 
example, the generated torque of the motor is reduced or the 
viscosity coefficient of the motor is decreased. Such load 
absorbing apparatus has a small variation of viscosity 
coefficients among parts and is lightly affected by temperature. 
In addition, the torque is detected by a simple process, which can 
realize a smaller and lighter robot apparatus even it contains 
motors. 

Since the AC component of load torque is impulsive, overload 
is applied at a moment and therefore the load absorbing operation 
may not be done in time. If based on the aforementioned 
characteristic in which the variation of kinetic energy is in 
proportion to a torque applied to the motor and its angular 
velocity, the overload can not be detected until the torque 
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reaches an overload state. This is a problem in response. 

For this problem, such process can be effective that, not 
the variation of kinetic energy is measured simply, but the 
kinetic energy is double-differentiated with respect to time, with 
the result that it is predicted that the AC component will become 
excessive when the inclination of the variation is a prescribed 
value or more, and then a load absorbing operation is performed. 

In addition, the double differentiation can be approximated 
by a product of the rate of change of a torque and the angular 
velocity. On the other hand, considering a characteristic in 
which motor torque is in proportion to motor current, the torque 
can be measured by converting the motor current into a voltage, so 
that the rate of change of the torque can be measured via the time 
differentiation of the voltage. 

Still further, in the load absorbing apparatus according to 
the fourth aspect of this invention, a load absorbing operation 
can be carried out based on both the AC component and the DC 
component of a load torque applied to a motor, so that the two- 
legged walking robot can cope with various shocks received, 
without any expectation while autonomously performing. 

According to the load absorbing apparatus of the second to 
fourth aspects of this invention, in a case where overload is 
applied to the single axis of a motor, the AC component and the DC 
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component of the load are properly absorbed, which can avoid 
breakage of the motor and members such as a link connected to the 
output shaft of the motor, and thereby preventing spreading of 
damage to other members . 

As a result, this invention can provide an advanced robot 
apparatus, and a load absorbing apparatus and method for motors 
used as actuators for joint motion of a multi- joint type robot. 

Further, this invention can provide an advanced robot 
apparatus, and a load absorbing apparatus and method, which are 
capable of properly detecting overload which may break motors or 
deform the body, and reducing the overload in the motors. 

Still further, this invention can provide an advanced robot 
apparatus, and a load absorbing apparatus and method, which are 
capable of appropriately preventing breakage of members and the 
body due to overload applied to motors having a single or multiple 
axes in a multi-joint type robot comprising a plurality of 
actuator motors . 

The nature, principle and utility of the invention will 
become more apparent from the following detailed description when 
read in conjunction with the accompanying drawings in which like 
parts are designated by like reference numerals or characters. 
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BRIEF DESCRIPTION OF THE DRAWINGS 



In the accompanying drawings: 

Fig. 1 is a conceptual drawing explaining motion of a 
movable part in a conventional robot; 

Fig. 2 is a conceptual drawing schematically showing the 
construction of a conventional torque limiter; 

Figs. 3 and 4 are perspective drawings showing an external 
construction of a robot 1 according to this embodiment; 

Fig. 5 is a schematic drawing explaining an external 
construction of the robot 1; 

Figs. 6 and 7 are block diagrams explaining an internal 
construction of the robot 1; 

Fig. 8 is a schematic view showing a structure of software 
control performed in the robot 1; 

Fig. 9 is a schematic view showing an internal structure of 
a middleware layer; 

Fig. 10 is a schematic view showing an internal structure of 
an application layer; 

. Fig. 11 is a schematic view showing an internal structure of 
an actuator Ai to A 2 4; 

Figs. 12A to 12C are drawings showing the constructions of a 
rotor shaft 64 and a rotor-shaft magnetic-pole angle sensor; 

Fig. 13 is a drawing showing a positional relationship among 
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a rotor 66 and stator cores 67A to 67F; 

Figs, 14A to 14C are drawings showing the construction of a 
torque amplification unit 61; 

Figs. 15A, 15B and 16 are drawings showing the construction 
of a control substrate 77; 

Fig. 17 is a drawing showing the constructions of a control 
IC 80 and a driving circuit 81; 

Fig. 18 is a view showing excess response characteristics of 
coil current in a case where the terminal ends of a coil are in an 
open state and in a short state; 

Fig. 19 is a view showing an example of a waveform of a 
BRAKE_PWM control signal; 

Fig. 20 is a specific view showing the construction of an 
additional logical circuit 92; 

Fig. 21 is a view showing a relationship between a duty 
cycle of the BRAKE_PWM control signal S14 and a viscosity 
coefficient of a motor unit 60; 

Fig. 22 is a view showing AC component and DC component of a 
load torque applied to an actuator; 

Figs. 23 and 24 are drawings explaining a mechanism of 
absorbing load according to this invention; 

Fig. 25 is a flowchart showing a first load absorbing 
processing procedure RTl to be carried out by an arithmetic 
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processing unit 90 of the control IC 80; 

Fig. 2 6 is a flowchart showing a second load absorbing 
processing procedure RT1 to be carried out by an arithmetic 
processing unit 90 of the control IC 80; 

Fig. 2 7 is a view showing an example of a result of torque 
detection; 

Fig. 2 8 is a drawing showing a situation in which the robot 
1 puts something between the legs in the middle of standing up 
from a lying position; 

Fig. 29 is a flowchart showing a processing procedure to 
detect shock load and constant load in an actuator having a single 
axis, to detect overload in an actuator motor having plural axes, 
and to perform a body protection operation in response to 
detection of these loads; 

Fig. 30 is a schematic view showing an operation on software 
to perform a load absorbing operation and a recovery operation for 
a case where shock load is applied to an actuator; 

Fig. 31 is a schematic view showing an operation on software 
to perform a load absorbing operation and a recovery operation for 
a case where constant load is applied to an actuator; and 

Fig. 32 is a schematic view showing a structure of the 
middleware layer for a case where load in a plurality of joint 
axes is determined to be totally excessive and a body protection 
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operation is performed. 

DETAILED DESCRIPTION OF THE EMBODIMENT 

Preferred embodiments of this invention will be described 
with reference to the accompanying drawings: 
(1) Construction of Robot of This Embodiment 

Fig. 3 and Fig. 4 show an entire construction of a two- 
legged walking robot according to one embodiment of the present 
invention. In addition, Fig. 5 schematically shows a structure of 
a degree of freedom in the robot. Reference numeral 1 shows a 
two-leg walking type robot as a whole, in which a head unit 3 is 
placed on a body unit 2, arm units 4A, 4B having the same 
construction are provided at upper left and right parts of the 
body unit 2, respectively, and leg units 5A, 5B having the same 
construction are provided at lower left and right parts of the 
body unit 2, respectively. 

The body unit 2 is constructed of an upper body frame 10 and 
a waist base 11 forming a lower body both of which are connected 
to each other via a waist joint mechanism 12. By driving each of 
actuators A lf A 2 of the waist joint mechanism 12 fixed to the 
waist base 11, the upper body can be rotated independently around 
a roll axis 13 and a pitch axis 14 which are orthogonal to each 
other as shown in Fig. 5. 
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Further, the head unit 3 is fixed on the center upper part 
of a shoulder base 15 fixed on the upper end of the frame 10 via a 
neck joint mechanism 16. By driving each of actuators A 3 , A 4 of 
the neck joint mechanism 16, the head unit 3 can be rotated 
independently around a pitch axis 17 and a yaw axis 18 which are 
orthogonal to one another as shown in Fig. 5. 

Furthermore, the arm units 4A, 4B are fixed to the left and 
right of the shoulder base 15, respectively, via a shoulder joint 
mechanism 19. By driving actuators A 5 , A 6 , A 9 , Ai 0 of the shoulder 
joint mechanism 19, the arm units 4A, 4B can be rotated 
independently around a pitch axis 20 and a roll axis 21 which are 
orthogonal to one another as shown in Fig. 5. 

In this case, as to the arm units 4A, 4B, actuators A 8 and 
A i2 forming forearms are connected to the output shafts of 
actuators A 7 and An forming upper arms, respectively, via elbow 
joint mechanisms 22, and a hand unit 23 is attached to the distal 
end of each forearm. The forearms can be rotated around a yaw 
axis 24 shown in Fig. 5 by driving the actuators A 7 and An. In 
addition, the forearms can be rotated around a pitch axis 2 5 shown 
in Fig. 5 by driving the actuators A 8 and A i2 . 

On the other hand, each leg unit 5A, 5B is attached to the 
waist base 11 via a hip joint mechanism 26. By driving actuators 
A 13 - Aie and A i9 to A 24 of the hip joint mechanism 26, the leg units 
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5A, 5B can be rotated independently around a yaw axis 27, a roll 
axis 28, and a pitch axis 2 9 which are orthogonal to one another 
as shown in Fig. 5. 

In this example shown, a lower-leg frame 32 is connected to 
the low end of a thigh frame 30 via a knee joint mechanism 31, and 
a foot unit 34 is connected to the low end of the frame 32 via an 
ankle joint mechanism 33. In each leg unit 5A, 5B, the lower leg 
can be rotated around a pitch axis 35 shown in Fig. 5 by driving 
an actuator Ai 6 or A22 of the knee joint mechanism 31. In addition, 
the foot unit 34 can be rotated independently around a pitch axis 
36 and a roll axis 37 which are orthogonal to each other as shown 
in Fig. 5, by driving actuators Ai 7 , Ai 8 , or A23, A 24 of the ankle 
joint mechanism 33. 

Fig. 6 schematically shows a control structure of the two- 
legged walking robot 1 according to this embodiment. On the back 
of the waist base 11, is arranged a control unit 42 housing a main 
control unit 40 for controlling the entire operation of the robot 
1, peripheral circuitry 41 including a power circuit and a 
communication circuit, a battery 45, etc. 

Fig. 7 schematically shows an internal structure of the 
control unit 42. This control unit 42 is connected to sub-control 
units 43A - 43D arranged in respective constituent units (body 
unit 2, head unit 3, arm units 4A, 4B, and leg units 5A, 5B), so 
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as to supply necessary power voltages to the sub-control units 4 3A 
to 43D and to communicate data with the units 43A to 43D. 

Connected to the actuators Ai - A 2 4 of the corresponding 
constituent units # each sub-control unit 43A - 43D is designed to 
be able to drive corresponding actuators Ai - A 2 4 in a manner 
specified by various commands given from the main control unit 40. 

Furthermore, as shown in Fig. 7, at predetermined positions 
on the head unit 3 are arranged various external sensors such as a 
Charge Coupled Device (CCD) camera 50 functioning as "eyes" of the 
robot 1 and a microphone 51 as "ears", and an output unit such as 
a loudspeaker 52 as a "mouth". On each of the palms of the hand 
units 23 and the soles of the foot units 34 is arranged a touch 
sensor 53 as an external sensor. In addition, inside the control 
unit 42 is arranged various internal sensors including a battery 
sensor 54 and an acceleration sensor 55. 

The CCD camera 50 captures surrounding environment and sends 
a captured video signal S1A to the main control unit 40. The 
microphone 51 collects external sounds and sends an obtained audio 
signal SIB to the main control unit 40. In addition, the touch 
sensor 53 detects physical pressures from a user and physical 
contacts with the outside, and sends a detected result to the main 
control unit 40 as a pressure signal SIC. Furthermore, the 
battery sensor 54 periodically detects an energy level of the 
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battery 45 serving as the main power source, and sends the 
detected result to the main control unit 40 as a battery level 
signal S2A. The acceleration sensor 56 periodically detects 
acceleration in three axes (x axis, y axis, and z axis), and sends 
the detected results to the main control unit 40 as an 
acceleration signal S2B. 

The main control unit 40 detects surrounding and internal 
conditions of the robot 1, contacts with an external entity, etc. 
based on the video signal S1A, the audio signal SIB, the pressure 
signal SIC, etc., being external sensor's outputs, and the battery 
level signal S2A, the acceleration signal S2B, etc. being internal 
sensor's outputs. 

Then the main control unit 40 determines a subsequent action 
based on the detected results, a control program being stored in 
an internal memory 40A, and various control parameters being 
stored in an external memory 5 6 being installed, and sends control 
commands based on the determined results to relevant sub-control 
units 43A - 43D. As a result, the specified actuators A x - A 2 4 are 
set in motion based on the control commands and under the control 
of the sub-control units 43A - 43D, thus letting the robot 1 take 
action, such as moving the head unit 3 up and down, left to right, 
raising the arm units 4A, 4B, and walking. 

In addition, the main control unit 40 recognizes user's 
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conversation through an audio recognition process based on the 
audio signal SIB, gives the loudspeaker 52 an audio signal S3 for 
response, resulting in output of synthesized sounds for 
communication with the user. 

As described above, the robot 1 is capable of behaving 
autonomously based on surrounding and internal conditions, and 
also capable of communicating with the user. 

Fig. 8 schematically shows a structure of control software 
operated on a two-legged walking robot 1 according to this 
embodiment . 

As shown in this figure, the robot control software is 
multilayer software in which an object-oriented programming is 
adopted. Each software comprises modules called "objects" 
integrating data and processing of the data. 

A device driver of the lowest layer comprises objects which 
are allowed to directly access hardware for driving of joint 
actuators, reception of sensor outputs and so on, and performs a 
suitable process in response to an interrupt request from the 
hardware . 

A virtual robot is an object which mediates between various 
device drivers and an object operating based on inter-object 
communication protocol. Each of hardware units composing the leg- 
type walking robot 1 is accessed via this virtual robot. 
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A service manager is a system object which induces each 
object to make a connection, based on information on connection 
between the objects stored in a connection file. 

Since each software having a higher ranking than a system 
layer (OS) comprises modules each representing an object (process), 
the objects are selectable and replaceable according to necessary 
functions. By rewriting the connection file, the inputs and 
outputs of objects having the same data structure are connected as 
desired. 

Software modules other than the device driver layer and the 
system layer are broadly classified into a middleware layer and an 
application layer. 

Fig. 9 schematically shows an internal structure of the 
middleware layer. 

The middleware layer is a collection of software modules to 
provide basic functions of the two-legged walking robot 1, the 
structure of each module is affected by hardware attribution such 
as mechanical and electrical features, specifications, and shapes 
of the two-legged walking robot 1. This middleware layer is 
functionally divided into a recognition middleware (the left half 
in Fig. 9) and an output middleware (the right half in Fig. 9). 

The recognition middleware receives and processes raw data 
from the hardware via the virtual robot, the raw data including 
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video data, audio data and other data obtained from other sensors. 
For example, this middleware performs various processes such as 
audio recognition, distance detection, posture detection, contact 
detection, motion detection, and color recognition, based various 
input information, to recognize the robot's situation (for example, 
"detected a ball", "fell down", "being pat", "being hit", "heard 
musical scales", or "detected a moving entity or an obstacle"). 
This recognized situation is notified to the higher-ranked 
application layer via an input semantics converter to be used for 
a subsequent action plan or learning. 

The output middleware, on the other hand, realizes functions 
for walking, moving, output of synchronized sounds, blinking 
control of the LEDs functioning as eyes. That is, the output 
middleware receives the action plan made by the application layer 
via an output semantics converter, and creates a servo command 
value for each joint of the two-legged walking robot 1, and sounds 
and light (LEDs) to be output, in order to let the robot 1 perform 
based on the plan via the virtual robot. In addition, this output 
middleware of this embodiment includes a load monitoring module 
for detecting whether load in a plurality of actuator motors are 
totally excessive and a module for executing a body protection 
operation when an overload state is detected (this will be 
described later). 
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Fig. 10 schematically shows an internal structure of the 
application layer. This application layer is composed of one or 
more application softwares for controlling robot's performance and 
internal conditions such as instinct and emotions. 

This application uses the recognized situation received via 
the input semantics converter to determine the action plan of the 
lag-type moving robot l f and notifies the determined plan via the 
output semantics converter. 

The application is composed of an emotional model, an 
instinct model, a learning module for sequentially storing 
experienced events, a behavioral model storing behavior patterns, 
and an action changing unit for moving the robot 1 based on the 
action plan determined by the behavioral model. 

The recognized situation input via the input semantics 
converter is input to the emotional model, the instinct model, and 
the behavioral model, and also to the learning module as a 
learning instruction signal. 

The action plan for the two-legged walking robot 1 
determined by the behavioral model is sent to the middleware via 
the action changing unit and the output semantics converter, so 
that the robot 1 takes the action. This action plan is also given 
to the emotional model, the instinct model and the learning module 
via the action changing unit as an action history. 
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Based on the recognized situation and the action history, 
the emotional model and the instinct model control the emotional 
parameter and instinct parameter, respectively. The behavioral 
model can refer to these parameters. In addition, the learning 
module updates an action-selection probability based on the 
learning instruction signal, and supplies the updated contents to 
the behavioral model. 

(2) Construction of Actuators A x to A 2 4 

As described above, a degree of freedom in each joint of the 
two-legged walking robot 1 according to this embodiment is 
realized by the actuators Ai to A 2 4. 

Fig. 11 shows the internal construction of each actuator Ai 
to A 24 . As shown in this figure, each actuator Ai to A 2 4 is 
composed of a motor unit 60 for generating a rotational torque and 
a torque amplification unit 61 for amplifying and outputting the 
rotational torque . 

In the motor unit 60, a rotor shaft 64 rotatably supported 
by bearings 63A, 63B is provided inside a motor case 62 made of 
conducting material such as metal. Figs. 12A to 12C show the 
constructions of the rotor shaft 64 and a rotor-shaft magnetic- 
pole angle sensor. As shown in Fig. 12A and 12B, a rotor 66 is 
formed in such a manner that a rotor base 65 and a rotor magnet 95 
which is a double pole ring permanent magnet are integrated 
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coaxially with the rotor shaft 64. 

Fig. 13 shows a relationship among the rotor 66 and stator 
cores 67A to 67F. As shown in this figure, inside the motor case 
62, six stator cores 67A to 67F are fixed every 60 degrees around 
the rotor 66. Three phase coils 68 (68A, 68B, 68C) are formed by 
winding a wire on the stator cores 67 (67A to 67F). 

As shown in Fig. 13, three pairs of two opposite coils 63 
are U-, V-, W-phase. By applying coil currents having 12 0-deegree 
phase difference to the U-, V-, W-phase coils 68, each coil 68 
generates a magnetic field corresponding to the drive current, so 
that the rotor 66 can generate a rotational torque corresponding 
to the coil current. 

Figs. 14A to 14C show the construction of the torque 
amplification unit 61. As apparent from Fig. 11, the torque 
amplification unit 61 has a gear case 69 detachably fixed to one 
end of the motor case 62. Inside this gear case 69, a planetary 
gear mechanism 73 is provided, the planetary gear mechanism 73 
having a ring internal gear 70 attached to the inside of the gear 
case 69, a sun gear 71 fixed to an end of the rotor shaft 64, and 
first to third planetary gears 72A to 72C arranged every 120 
degrees between the internal gear 70 and the sun gear 71. 

In addition, each shaft 74A to 74C of the first to third 
planetary gears 72A to 72C are fixed to the output shaft 75 
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rotatably arranged at an end of the gear case 69. Therefore, the 
torque amplification unit 61 can amplify a rotational torque given 
from the motor unit 60 via the rotor shaft 64, via the planetary 
gear mechanism 73 and then output the resultant to the outside via 
the output shaft 75. 

In addition, the motor case 62 of the motor unit 60 contains 
an encoder 76 for detecting rotations of the rotor shaft 64 and a 
control substrate 77 for controlling a rotation angle and a 
rotational torque of the rotor shaft 64 in response to an 
operation command from a higher-ranked controller (corresponding 
sub-control unit 43A to 43D) (see Fig. 11). 

In this case, the encoder 76 is composed of the double-pole 
resin magnet 78 and first and second hole elements 79A, 79B (see 
Figs. 12A to 12C). Figs. 15A and 15B show the construction of the 
control substrate 77. As shown in Fig. 15B, the first and second 
hole elements 79A, 79B are arranged coaxially with the rotor shaft 
64 at 90 degree phase difference on the control substrate 77. 

Therefore, the encoder 7 6 is capable of detecting the 
rotational position of the rotor shaft 64 as the change of 
magnetic flux density at the first and second hole elements 79A, 
79B, the change going with the rotation of the resin magnet 78 
which rotates together with the rotor shaft 64. 

Further, as shown in Fig. 16, in the control substrate 77, a 
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control IC 80 and a drive circuit 81 for supplying drive currents 
Iu, Iv, Iw to the coils 68u, 68v, 68w of the motor unit 60 under 
the control of the control IC 80 are arranged on a circular 
printed wiring board. The control IC 80 is capable of receiving 
the outputs of the first and second hole elements 79A, 79B as 
first and second position signals S10A, S10B, respectively, and 
thereby detecting the rotational position of the rotor shaft 64 
based on the signals. 

The control substrate 7 7 is connected to a higher-ranked 
controller (corresponding sub control unit) via a cable 83 (see 
Fig. 11), so that the control IC 80 can communicate with the 
higher-ranked controller via the cable 83 and be supplied with 
power voltage Vcc . 

Then, the control IC 80 controls the drive circuit 81 based 
on the operation command COM given from the higher-ranked ' 
controller via the cable 83 and the first and second position 
signals S10A, S10B, to apply the drive currents Iu, Iv, Iw to 
corresponding U-, V-, and W-phase coils 68 of the motor unit 60, 
so that the motor unit 6 0 can rotate by a rotation angle or 
generate a rotational torque depending on the operation command 
COM. 

(3) Constructions of Control IC 80 and Drive Circuit 81 

Fig. 17 shows the constructions of the control IC 80 and the 
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drive circuit 81- As shown in this figure, the control IC 80 is 
composed of an arithmetic processing unit 90, a PWM control unit 
91, and an additional logical circuit 92. 

The arithmetic processing unit 90 is constructed like a 
microcomputer including a CPU, ROM and RAM, and this unit 90 
obtains a difference between a targeted rotational position of the 
rotor shaft 64 of the motor unit 60 based on the operation command 
COM from the higher-ranked controller and the current rotational 
position of the rotor shaft 64 obtained based on the first and 
second position signals S10A, S10B given from the encoder 76, and 
also calculates a targeted output torque (hereinafter, referred to 
as a targeted torque) in order to eliminate the difference, and 
sends the calculation result to the PWM control unit 91 as a 
torque command signal S12. 

The PWM control unit 91 PWM-controls the drive circuit 81 
via the additional logical circuit 92 based on the torque command 
signal S12 so that the motor unit 60 can generate the targeted 
torque as its output torque. 

The drive circuit 81 is composed of a pair of PNP transistor 
TRul and NPN transistor TRu2 for U phase, a pair of PNP transistor 
TRvl and NPN transistor TRv2 for V phase, and a pair of PNP 
transistor TRwl and NPN transistor TRw2 for W phase. 

Each emitter of the PNP transistors TRul, TRvl, TRwl is 



30 



connected to the power voltage Vcc f the collectors of the PNP 
transistors TRul, TRvl, TRwl are connected to the collectors of 
the NPN transistors TRu2 , TRv2 , TRw2 , respectively, and each 
emitter of the NPN transistors TRul, TRvl, TRwl is grounded. In 
addition, the connecting points PI to P3 connecting the collectors 
of the PNP transistors TRul, TRvl, TRwl and the collectors of the 
corresponding NPN transistors TRu2 , TRv2, TRw2 are connected to a 
connecting point P4 between the U-phase coil 68u and the W-phase 
coil 68w, a connecting point P5 between the U-phase coil 68u and 
the V-phase coil 68v, and a connecting point P6 between the V- 
phase coil 68v and the W-phase coil 68w. 

By turning ON the PNP transistor TRul and the NPN transistor 
TRv2 and turning OFF the NPN transistor TRu2 and the PNP 
transistor TRvl, the U-phase coil 68u becomes conductive to flow 
the drive current IU in an arrow direction. In addition, by 
turning OFF the PNP transistors TRul, TRvl and the NPN transistors 
TRu2, TRv2, the terminals P4, P5 are put in an open state and the 
U-phase coil 68u becomes nonconductive . 

Similarly, by turning ON the PNP transistors TRvl and the 
NPN transistor TRw2 and turning OFF the NPN transistor TRv2 and 
the PNP transistor TRwl, the V-phase coil 68v becomes conductive 
to flow the drive current IV in an arrow direction. In addition, 
by turning OFF the PNP transistors TRvl, TRwl and the NPN 
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transistors TRv2, TRw2 , the terminals P5, P6 are put in an open 
state and the V-phase coil 68v becomes nonconductive. 

Further, similarly, by turning ON the PNP transistors TRwl 
and the NPN transistor TRu2 and turning OFF the NPN transistor 
TRw2 and the PNP transistor TRul OFF, the W-phase coil 68w becomes 
conductive to flow the drive current IW in an arrow direction. In 
addition, by turning OFF the PNP transistors TRwl, TRul and the 
NPN transistors TRw2 , TRu2, the terminals P6, P4 are put in an 
open state and the w-phase coil 68w becomes nonconductive. 

As a result, the PWM control unit 91 gives first to sixth 
PWM signals S13ul, S13u2, S13vl, S13v2, S13wl, S13w2 corresponding 
to the targeted torque obtained based on the torque command signal 
S12, to the bases of the corresponding PNP transistors TRul, TRvl, 
TRwl and the NPN transistors TRu2 , TRv2 , TRw2, to thereby switch 
each of the U-, V-, and W-phase coils 68u, 68v, 68w between the 
conductive state and the nonconductive state, resulting in 
rotation of the motor unit 60. 

Note that, in the case where the position of the motor unit 
60 is controlled by the PWM control, putting the terminals P4, P5, 
P6 in the open state while the coils 68u, 68v, 68w are 
nonconductive arises problems in that a torque loss occurs because 
current existing in the motor unit 60 (strictly, charge) is easy 
to be lost and cogging torque is easy to affect the control. 



32 



However, this embodiment solves the torque loss problem by 
utilizing such a fact that currents (strictly charge) existing in 
the coils 68u, 68v, 68w do not decrease easily by putting the 
terminals P4, P5 , P6 of the coils 68u, 68v, 68w in the short state, 
not in the open state, while the coils 68u, 68v, 68w are 
nonconductive . Fig. 18 shows the excessive response 
characteristics of coil current for cases where the ends of a coil 
are put in the open state and the short state. As clear from this 
figure, the short state requires a longer settling time, so that 
the coil current does not decrease easily. 

This is because putting the terminals P4, P5, P6 in the 
short state causes a time delay in the excessive response which is 
resulted from DC resistance and inductance of the coils 68u, 68v, 
68w of the motor unit 60. In addition, in the short state, a 
magnetic flux density from the rotor magnet 95 generates a reverse 
electromotive force to the coils 68u, 68v, 68w. This reverse 
electromotive force is applied in a reverse direction of rotation 
of the rotor 66 to generate a viscosity resistance against the 
rotation by an external force, which obtains an effect like a 
break. Such viscosity resistance generated by creating a 
viscosity coefficient against the motor unit 60 can reduce the 
effect of the cogging torque without torque loss. 

However, putting the terminals P4, P5, P6 of the coils 68u, 
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68v f 68w in the short state means applying a kind of viscosity 
resistance to the motor unit 60, which arises another problem in 
that a break due to the short states of the terminals P4, P5, P6 
of the coils 68u, 68v, 68w loses compliance .in the motor unit 60, 
In this embodiment, to solve the above torque loss problem 
and this compliance problem together, the terminals P4, P5, P6 of 
the coils 68u, 68v, 68w are alternatively switched between the 
open state and the short state while the coils 68u, 68v, 68w are 
nonconductive, and a ratio of a period for the open state to a 
period for the short state is adjusted so as to obtain desired 
compliance . 

Actually, as a means for alternatively switching the 
terminals P4, P5, P6 of the coils 68u, 68v, 68w between the open 
state and the short state, the additional logical circuit 92 is 
provided at a latter stage of the PWM control unit 91 • The 
additional logical circuit 92 is given, for example, a BRAKE_PWM 
control signal S14 of a short waveform together with the first to 
sixth PWM signals S13ul, S13u2, S13vl, S13v2, S13wl, S13w2, from 
the PWM control unit 91, the signal S14 being subjected to PWM 
modulation according to a prescribed ratio of a period for the 
open state to a period for the short state regarding the terminal 
P4, P5, P6 . Fig. 19 shows a waveform example of the BRAKE_PWM 
control signal. 
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The additional logical circuit 92 changes, according to 
necessity, the logical levels of the corresponding first to sixth 
PWM signals S13ul, S13u2, S13vl, S13v2, S13wl, S13w2 so as to put 
the terminals P4, P5, P6 of the coils 68u, 68v, 68w in the short 
state while the coils 68u, 68v, 68w are nonconductive and the 
BRAKE_PWM control signal S14 has a logical level "1". 

Specifically, to put the terminals P4, P5 of the U-phase 
coil 68u in the open state while the coils are nonconductive, the 
PWM control unit 91 normally outputs the first to fourth PWM 
signals S13ul, S13u2, S13vl, S13v2 to turn OFF the PNP transistors 
TRul, TRuvl and the NPN transistors TRu2, TRv2 . However, the 
additional logical circuit 92 intermittently puts the terminals P4, 
P5 in the short state by turning ON the PNP transistors TRul, TRvl, 
which are currently off, while the BRAKE_PWM control signal S14 
has a logical level "1", 

Similarly, to put the terminals P5, P6 of the V-phase coil 
68v in the open state while the coils are nonconductive, the PWM 
control unit 91 normally outputs the third to sixth PWM signals 
S13vl, S13v2, S13wl, S13w2 to turn OFF the PNP transistors TRvl, 
TRwl and the NPN transistors TRv2 , TRw2 . However, the additional 
logical circuit 92 intermittently puts the terminals P5, P6 in the 
short state by turning ON the PNP transistors TRvl, TRwl, which 
are currently OFF, while the BRAKE_PWM control signal S14 has a 
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logical level "1". 

Further, similarly, to put the terminals P6, P4 of the W- 
phase coil 68w in the open state while the coils are nonconductive, 
the PWM control unit 91 normally outputs the first, second, fifth, 
and sixth PWM signals S13ul, S13u2, S13wl, S13w2 to turn OFF the 
PNP transistors TRwl, TRul and the NPN transistors TRw2 , TRu2 . 
However, the additional logical circuit 92 intermittently puts the 
terminal P6, P4 in a short state by turning ON the PNP transistors 
TRwl, TRul, which are currently OFF, while the BRAKE_PWM control 
signal S14 has a logical level "1". 

In a case where the BRAKE_PWM control signal S14 has a 
logical level M 0" while the coils are nonconductive, on the other 
hand, the additional logical circuit 92 normally outputs the first 
to sixth PWM signals S13ul, S13u2, S13vl, S13v2, S13wl, S13w2 from 
the PWM control unit 91 as they are, resulting in leaving the 
terminals P4, P5, P6 of the coils 68u, 68v, 68w in the open state. 

Fig. 20 shows the specific construction of the additional 
logical circuit 92. An AND gate 100 performs AND operation on the 
first, third and fifth PWM signals S13ul, S13vl, and S13wl from 
the PWM control unit 91 while an exclusive NOR gate 101 performs 
exclusive NOR operation on the second, fourth, and sixth PWM 
signals S13u2, S13v2, S13w2. 

Then, a NAND gate 102B performs NAND operation on the output 
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of the AND gate 100 and the output of the exclusive NOR gate 101, 
and an OR gate 103 performs OR operation on the output of the NAND 
gate 102B and the output of an inverting buffer 102A, i.e., the 
signal opposite the BRAKE_JPWM control signal S14. 

Then, first to sixth AND gates 104A to 104F perform AND 
operation on the output of the OR gate 103 and the original first 
to sixth PWM signals S13ul, S13u2, S13vl, S13v2, S13wl, S13w2, 
respectively, and the outputs of these first to sixth AND gates 
104A to 104F are given to the PNP transistor TRul, NPN transistor 
TRu2, PNP transistor TRvl, NPN transistor TRv2 , PNP transistor 
TRwl, and NPN transistor TRw2 , respectively. 

As described with reference to Fig. 18, by putting the 
terminals P4, P5, P6 of the coils 68u, 68v, 68w in the short state 
while the coils are nonconductive , the drive currents Iu, Iv, Iw 
of the coils 68u, 68v, 68w take a longer time to become zero 
because of the excessive response. Therefore, while the coils 68u, 
68v, 68w are nonconductive, current starts to flow before the 
drive currents Iu, Iv, Iw become zero, by repeatedly switching the 
open state and the short state. 

Therefore, the maximum values of the drive currents Iu, Iv, 
Iw to be supplied to the coils 68u, 68v, 68w gradually increase 
every time when the coils 68u, 68v, 68w become conductive and 
nonconductive, and the increasing rate almost corresponds to a 
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duty cycle, that is, a rate in which the BRAKE_PWM control signal 
S14 becomes a logical level "1". Similarly, the effective values 
of the drive currents Iu, Iv, Iw of the coils 68u, 68v, 68w also 
gradually increase and the increasing rate almost corresponds to 
the duty cycle, that is, a rate in which the BRAKE_PWM control 
signal S14 becomes a logical level "1". 

In addition, since the output torque of the motor unit 60 is 
calculated by multiply a torque constant Kt of the motor unit 60 
and a sum of the values of the drive currents Iu, Iv, Iw to be 
supplied to the coils 68u, 68v, 68w. Therefore, when the coils 
68u, 68v, 68w are repeatedly switched between the conductive state 
and the nonconductive state, the effective value of the output 
torque in the motor unit 60 increases with increasing the sum of 
the values of the drive currents Iu, Iv, Iw. 

The increasing rate of this case almost corresponds to the 
duty cycle of the BRAKE_PWM control signal S14, that is, a rate in 
which the BRAKE_PWM control signal S14 becomes a logical level "1". 
And the inclination of increase of the output torque of the motor 
unit 60 is in proportion to the viscosity coefficient of the motor 
unit 60. In other words, the viscosity coefficient of the motor 
unit 60 can be dynamically and optionally determined within a 
range of duty resolution with the duty cycle of the BRAKE_PWM 
control signal S14. 
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As a result, the viscosity coefficient of the motor unit 60 
can be controlled by changing the duty cycle of the BRAKE_PWM 
control signal S14, and the currents (the amount of charge) to 
flow in the coils 68u, 68v, 68w can be controlled while the coils 
68u, 68v, 68w are nonconductive. 

When the duty cycle of the BRAKE_PWM control signal S14 is 
determined so that the viscosity coefficient becomes large, the 
motor unit 60 has high holding power, resulting in reducing 
disturbance such as cogging torque. In addition, the amount of 
compliance toward an external force can be controlled. 

The PWM control of the duty cycle of the BRAKE_PWM control 
signal S14 to be supplied to the additional logical circuit 92, 
which is performed by the PWM control unit 91, adjusts a ratio of 
the period for the open state to the period for the short state in 
the terminals P4, P5, P6 of the coils 68u, 68v, 68w while the 
coils are nonconductive, thereby obtaining desired compliance. 
Fig. 21 shows a relationship between the duty cycle of the 
BRAKE_PWM control signal S14 and the viscosity coefficient of the 
motor unit 60. 

(4) Load Absorbing Mechanism in Each Actuator Ai to A 2 4 

An advanced two-legged walking robot autonomously walks and 
moves. Further, the robot can make motion such as standing up 
from a lying state and holding and carrying objects with its arms. 
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On the other hand, such case may arise that overload is applied to 
joint actuators due to falling down, dumping into something, or 
getting something into its body. Such overload may cause fatal 
damage such as breakage or plastic deformation of the body. 
Therefore, it is very important to provide each motor composing 
the joint actuators with a mechanism to absorb load. 

First, a load absorbing function which is provided in each 
actuator A x to A 2 4 for joint motion in this robot 1 will be 
described. 

The inventors of this invention treat load torque to be 
applied to a motor for a joint actuator by broadly classifying it 
into impulsive "shock load" which incurs distortion energy and may 
break members such as links, due to bumping or the like and 
"constant load" which is relatively high load torque, although not 
so high as the shock load, and causes plastic deformation (see Fig. 
22) if constantly applied for a prescribed period of time or 
longer. The latter constant load torque value is a value around a 
stall torque of a motor used, or a threshold value such as a 
limitation for circuit protection. The inventors position the 
shock load and the constant load as AC component and DC component, 
respectively. 

The constant load, that is, the DC component of a load 
torque is detected based on the sum of absolute values of a load 
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torque to be applied to a link connected to the output shaft of an 
actuator motor and a generated torque by the actuator motor. Then, 
it is recognized that the DC component is excessive in a case 
where the total torque exceeds a threshold value which may cause 
plastic deformation when applied for a prescribed period of time 
or longer. Since the generated torque of a motor is in proportion 
to motor current, the torque can be measured by converting the 
motor current into a voltage. 

For example, as shown in Fig. 23, suppose that, in a 
situation where a link 112 of which one end is linked with the 
output shaft 111 of an actuator 110 can not move because it's the 
other end (which is LI distant from the output shaft 111) is 
contacting with a wall or an entity, the other end of the link 112 
is given an external force Fl from the wall or the entity and the 
actuator 10 generates a torque by the newly increased load. 

In this case, a condition where the actuator 110 is not 
broken is as follows: 

FIXLI+Tqut^Tbrk (1) 

where T out is the generated torque being generated firstly by the 
actuator 110 and T BRK is a load torque which will break the 
actuator 110 if applied to the output shaft 111 of the actuator 
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110. That is, the condition is that the sum of absolute values of 
a load torque newly caused by an external force Fl and the 
generated torque T ou t by the actuator 110 does not exceed T BRK for a 
prescribed period of time or longer. 

Such generated torque T out corresponds to the DC component of 
load and is referred to as " static load torque" hereinafter. 
Based on the above equation (1), by controlling the generated 
torque T ou t of the actuator 110 so as to satisfy the following 
equation, the actuator 110 can be previously prevented from being 
broken. 

Tout = Tbrk~F1 X 

li .<2> 

The generated torque T ou t of the actuator 110 can be detected 
as a coil current supplied to the actuator 110. Now, Fig. 27 
shows current values corresponding to torque, where a threshold 
value for the coil current into which a threshold value for a load 
torque is converted is 2 . 5A and a time limit for continuous of 
this threshold value is 2.0 seconds. Continuous sampling of 
current values have a chattering problem. That is, even a value 
greater than 2.5A actually continues for 2.0 seconds, a counter is 
reset because of the chattering every time when the value falls 
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below the threshold value, which may miss detection timing. For 
such a case, such operation can be effective that, if a period of 
time when the value is below the threshold value is very short 
(for example, for only 4.0 milliseconds or shorter), the counter 
keeps on counting. 

As to the shock load, that is, the AC component of load, on 
the other hand, the inventors introduced a fact in that the 
variation of kinetic energy to be applied to the output shaft of a 
motor is in proportion to a product of a torque to be applied to 
the motor and the angular velocity. In addition, since the 
kinetic energy is almost equal to distortion energy added to the 
output shaft member, a load torque corresponding to a shock is 
detected based on the variation of the kinetic energy, and the AC 
component of load is recognized excessive when the load torque 
exceeds a threshold value which may break a member. 

For example, a case shown in Fig. 2 4 will be considered 
where 1 such a load torque as to rotate the link 112 is applied to 
the other end of the link 112 (which is L2 distance from the 
output shaft 111) due to, for example, an entity falling on the 
other end. Such a load torque corresponds to the AC component of 
load and is referred to as " dynamic load torque" hereinafter. 

Kinetic energy K E of this time, which is applied to the link 
112 by the dynamic load torque, is derived from the follows: 
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1 

K E = — xSx<p 2 ....(3) 
2 

where 0 is a rotation angle of the link 112 and J is an inertia 
moment of the link 112. 

Assuming that all of this kinetic energy K E travel to the 
actuator 110 through the output shaft 111 and are converted into 
distortion energy. This distortion energy does not break the 
actuator 110 when it is under ah elastic limit in the actuator 
110; and the distortion energy breaks the actuator 110 f otherwise. 

When the distortion energy becomes over the elastic limit, 
the generated torque T ou t of the actuator 110 is reduced in order 
to prevent the breakage of the actuator 110 due to the dynamic 
load torque . 

Specifically, to detect the variation of the kinetic energy 
K E of the dynamic load torque applied to the link 112, the 
equation (3) is single-differentiated with respect to time as 
follows : 



— (K E ) = Ixc))x(J) = xx(J) 
dt 



(4) 
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where T represents an output torque of the actuator 110. That is, 
since the variation of energy is in proportion to a product of the 
torque applied to the motor and the angular velocity, the load 
torque is detected based on the variation of energy, and the AC 
component of load is recognized excessive when the load torque 
exceeds a threshold value that may break a member. 

Now, since the AC component of a load torque is impulsive 
(refer to Fig. 4), the component reaches an overload state at 
moment and therefore, a load absorbing operation may not be 
carried out in time. As described above, if based on a 
characteristic in which the variation of energy is in proportion 
to a product of a torque applied to a motor and the angular 
velocity, overload can not be detected until the torque reaches an 
overload state, which arises a problem in response. 

Therefore, the variation of energy is not measured simply, 
but the inclination of the variation is considered by double 
differentiation of the energy with respect to time. Then, it is 
predicted that the torque will reach an overload state if the 
inclination is more than a prescribed value, with the result that 
the load absorbing operation can be carried out with 

good response. The equation (4) is further differentiated with 
respect to time as follows (that is, the aforementioned equation 
(3) is double-differentiated with respect time t): 
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The equation (5) represents acceleration of variation of the 
kinetic energy K E . When the right-hand side of the equation (5) 
is a prescribed threshold value or greater which is a boarder 
between the elastic range and the plastic range of each member in 
the actuator 110 f the generated torque T ou t of the actuator 110 is 
reduced in order to previously prevent breakage of the actuator 
110. 

However, the double differentiation process like the 
equation (5) is not simple. In addition, the inventors realized 
that the second item of the right-hand side in the equation (5) 
makes a small contribution to the operation result. Therefore, 
the second item is omitted and the right-hand side of the equation 
(5) is made approximate to the product of the first item of the 
right-hand side and a prescribed gain G k , as follows: 

/(/) = 6>xrx0 (6) 

where f(t) is an evaluation function. 

The generated torque T ou t is reduced when the evaluation 
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function f(t) becomes over the above-described threshold value. 
As a result, the actuator 110 can be previously prevented from 
being broken, with the simpler arithmetic process. Fig. 34 shows 
a comparison in a response characteristic of the load absorbing 
mechanism between a case based on the variation of kinetic energy 
K E and a case in which the evaluation function f(t) is introduced. 
As clear from this figure, the latter case can detect an overload 
state with a better response at a time of a lower generated torque. 

The control substrate 7 7 operates as a load absorbing means 
for preventing breakage of the actuators A x to A 24 due to the 
static or dynamic load torque, which was described with reference 
to Fig. 23 and Fig. 24, based on the aforementioned principles. 
As shown in Fig. 16, a voltage detection unit 82 for detecting as 
voltage Vi the amount of a current I R i flowing in a power line LIN 
for the drive circuit 81 is provided on the printed wiring board 
of the control substrate 77. 

The voltage detection unit 82 is formed of a first 
resistance Ri provided on the power line LIN and a differential 
amplifier 84 composed of second to fifth resistances R 2 to R 5 and 
an operational amplifier 83. The differential amplifier 84 
detects a fall voltage Vi in the first resistance Ri and sends the 
detected result to the control IC 80 as a voltage signal Sll. 

Since the voltage Vi is in proportion to the current I R i 
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flowing in the first resistance Ri and this current I Ri is in 
proportion to the left-hand side of the equation (1), the voltage 
Vi is also in proportion to the left-hand side of the equation (1). 
Now, it is supposed that the following equation is realized: 



Therefore, the actuator Ai to A 2 4 can be prevented from being 
broken due to a static load torque by controlling the PWM control 
unit 91 so as to satisfy the following equation: 



Fig. 25 is a flowchart of the first load absorbing 
processing procedure RTl which is performed by the arithmetic 
processing unit 90 of the control IC 80. The arithmetic 
processing unit 90 controls the PWM control unit 91 based on the 
voltage signal Sll given from the voltage detection unit 82 so as 
that the voltage Vi does not exceed a prescribed preset first 
threshold value SHI (T B R K /K V i in the equation (8)), which prevents 
the actuator Ai to A 2 4 from being broken in a case where the static 



FlXLl+T 0 ut = KviXVi^T; 



BRK 



(7) 



where K vi is a proportionality constant. 




(8) 
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load torque, that is, the DC component of the load is applied to 
the corresponding link. 

The arithmetic processing unit 90 starts the first shock 
absorbing processing procedure RT1 from step SPO, in parallel to 
the positional control of the corresponding motor unit 60 based on 
the operation command COM given from the higher-ranked controller 
as described above, and judges at step SPl whether the voltage Vi 
obtained based on the voltage signal Sll given from the voltage 
detection unit 82 is the first threshold value SHI or greater. 
When a negative result is obtained at step SPl, the arithmetic 
processing unit 90 repeats this step SPl until an affirmative 
result is obtained. 

Then, when an affirmative result is obtained at step SPl by, 
for example, applying a static load torque to the corresponding 
link due to contact of the link with a wall or an entity, the 
arithmetic processing unit 90 goes on to step SP2 to control the 
PWM control unit 91 so as to increase the compliance of the 
corresponding motor unit 60 by changing the duty cycle of the 
BRAKE_PWM control signal S14 to 0%, and then goes on to step SP3 
to control the PWM control unit 91 so as to reduce the effective 
value of the current which flows in each coil 68u, 68v, 68w of the 
motor unit 60, thereby obtaining reduced generated torque T ou t. 

Then, the arithmetic processing unit 90 goes on to step SP4 
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to inform the higher-ranked controller of the execution of the 
shock absorbing process (steps SP2 and SP3), and goes on to step 
SP5 to wait for an instruction to stop the shock absorbing process 
from the higher-ranked controller. 

When the arithmetic processing unit 90 receives such 
notification from the higher-ranked controller and therefore 
obtains an affirmative result at step SP5, it proceeds to step SP6 
to change the duty cycle of the BRAKE_PWM control signal S14, that 
is, the motor viscosity coefficient, to the original value by 
controlling the PWM control unit 91 and thereby return the 
compliance of the motor unit 60 to the state before the shock is 
detected. Then, the arithmetic processing unit 90 proceeds to 
step SP7 to control the PWM control unit 91 to return the 
effective value of the drive current Iu, Iv, Iw to be applied to 
each coil 68u, 68v, 68w of the motor unit 60 to the original value, 
with the result that the generated torque T ou t has a prescribed 
value. Then, the arithmetic processing unit 90 returns back to 
step SPl to repeat the above processes. 

As described above, the arithmetic processing unit 90 
controls the motor viscosity coefficient and the generated torque 
Tout of the motor unit 60 in the corresponding actuator A x to A 24 
when a static load torque is applied to a corresponding link. 

On the other hand, as is clear from the equation (6), the 
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output torque X of the actuator Ai to A 2 4 is in proportion to the 
current I R i flowing into the resistance Ri in the voltage detection 
unit 82 and the current I R i is in proportion to the fall voltage Vi 
due to the first resistance Ri . Therefore, the equation (6) can 
be transformed into: 



f(t) = G k xTxi=G k x — x^ = K i x^xK Q x^- (9) 

dt dt dt dt 

where Ki and K e are proportionality constants. 

As is clear from the equation (9), the evaluation function 
f(t) in the equation (6) is derived by a product of a result of 
multiplying the temporal variation of voltage V if detected by the 
voltage detection unit 82 , and the proportionality constant Ki and 
a result of multiplying the amount of temporal change of the 
rotational position 0 of the rotor shaft 64 of the motor unit 60 , 
detected by the encoder 76, and the proportionality constant K B . 

Fig. 2 6 shows a flowchart of a second load absorbing 
processing procedure RT2 which is performed by the arithmetic 
processing unit 90 of the control IC 80. The arithmetic 
processing unit 90 prevents the actuator Ai to A i4 from being 
broken in a case where a dynamic load torque, that is, the AC 
component of load, is applied to a corresponding link, by 
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controlling the PWM control unit 91 following the second load 
absorbing processing procedure RT2 , based on a voltage Vi and a 
rotational position 0 of the rotor shaft 64 of the motor unit 60 
so that the evaluation function f(t) does not exceed a preset 
prescribed second threshold value SH2 , the voltage Vi obtained 
based on the voltage signal Sll given from the voltage detection 
unit 82, the rotational position <t> obtained based on the first 
and second position signals S10A, S10B given from the encoder 76. 

In parallel to the first shock absorbing processing 
procedure RTl, the arithmetic processing unit 90 starts the second 
shock absorbing processing procedure RT2 from step SP10. At step 
SPll, the arithmetic processing unit 90 calculates the equation 
(9) based on the voltage signal Sll and the position signals S10A, 
S10B and then judges whether the result is the second threshold 
value SH2 or greater. Note that, in this embodiment, Ki and K e are 
taken to 1.0 and 4.0, respectively, and the second threshold value 
SH2 is taken to be a value between 1.3 and 4.0 mN-m-rad/S2 which 
is considered to be most optimal from experiment. The arithmetic 
processing unit 90 repeats this step SPll until an affirmative 
result is obtained. 

When the corresponding link receives a shock and thereby an 
affirmative result is obtained at step SPll, the arithmetic 
processing unit 90 goes on to step SP12 to change the duty cycle 
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of the BRAKE_PWM control, signal S14 to 0% to increase the 
compliance of the motor unit 60 by controlling the PWM control 
unit 91. Then, at next step SP13, the arithmetic processing unit 
90 controls the PWM control unit 91 to create the generated torque 
Tout so that the maximum value of the targeted torque calculated 
based on the operation command from the higher-ranked controller 
takes a value between 10 to 20% of the actually calculated value. 

Next, the arithmetic processing unit 90 goes on to step SP14 
to inform the higher-raked controller of the execution of the 
shock absorbing process (steps SP12 and SP13) and goes on to SP15 
where it waits for an instruction to stop the shock absorbing 
process from the higher-ranked controller. 

When the arithmetic processing unit 90 receives such a 
notification from the higher-ranked controller and thereby an 
affirmative result is obtained at step SP15, it proceeds to step 
SP16 to return the duty cycle of the BRAKE_PWM control signal S14, 
that is, the motor viscosity coefficient to the original value by 
controlling the PWM control unit 91 to return the compliance of 
the motor unit 60 to a state before the shock is detected. Then, 
at step SP17, the arithmetic processing unit 90 returns the 
effective value of the drive current Iu, Iv, Iw to be applied to 
each coil 68u, 68v, 68w of the motor unit 60 to the original value 
by controlling the PWM control unit 91 in order to thereby return 
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the generated torque T out to the prescribed value. Then, the 
arithmetic processing unit 90 returns back to step SPll and 
repeats the aforementioned processes. 

As described above, the arithmetic processing unit 90 
controls the motor viscosity coefficient and the generated torque 
of the motor unit 60 in the corresponding actuator in a case where 
a dynamic load torque is applied to the corresponding link. 

In the aforementioned mechanism, in this robot 1, when a 
static or dynamic load torque which may break any actuator Ai to 
A 24 is applied to a corresponding link connected with the output 
shaft 75 of the actuator, the compliance of the actuator Ai to A 2 4 
increases and the output torque of the actuator Ai to A 2 4 decreases, 
resulting in deformation of the link according to the load torque. 

For example, this robot 1 is capable of previously 
preventing damage of the actuators Ai to A 2 4 due to shock as in the 
case where a conventional torque limiter 130 is used as described 
with reference to Fig. 1, and in addition, the load absorbing is 
performed only by controlling the electrical actuators Ai to A 24 . 
As compared with the case of using the conventional torque limiter 
130 having a mechanical construction, the actuators Ai to A 24 do 
not have big differences in performance regarding the shock 
absorbing function and also are lightly affected by temperature. 

In addition, the control IC 80 can control the load 
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absorbing operation as well as performing the usual positional 
control of the actuators Ai to A 24 . That is, since new units are 
not required, the actuators A a to A 24 can be constructed simpler, 
smaller and lighter, as compared with the conventional torque 
limiter 130 having the mechanical construction. 

According to the above construction, a sum of absolute 
values of a static load torque applied to a link connected to the 
output shaft 75 of an actuator Ai to A 24 and the generated torque 
of the actuator A x to A 24 is obtained as a voltage Vi, and when the 
sum is the first threshold value SHI or greater, the actuator Ai 
to A 24 is controlled so as to reduce the generated torque. In 
addition, a variation of energy of a dynamic load torque applied 
to the link is detected, and when the detected variation is the 
prescribed second threshold value SH2 or greater, the actuator A ± 
to A 24 is controlled so as to reduce the generated torque. 
Therefore, as compared with the conventional torque limiter 130 
having the mechanical construction, the actuators Ai to A 24 do not 
have big differences in performance regarding the load absorbing 
function and are lightly affected by temperature, thus making it 
possible to realize a easy-to-use load absorbing apparatus. 

In addition, by using the load absorbing apparatus according 
to this invention, the actuator Ai to A 24 , that is, the entire 
system can be constructed simpler, smaller and lighter, as 
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compared with the conventional torque limiter 130 having the 
mechanical construction. 

(5) Load Absorbing Mechanism for the Entire Robot 

When overload is applied to a single axis of an actuator 
motor, the aforementioned load absorbing mechanism for the 
actuator A 1 to A 2 4 is effective to appropriately absorb the AC 
component and the DC component of the load, so as to prevent 
breakage of the motor and members such as a link connected to the 
output shaft of the motor and therefore avoid the spreading of 
damage into other members. 

On the other hand, multi-joint type robot including leg-type 
walking robot is composed of a plurality of motors for joint 
actuators and links connected with the output shafts of the motors. 
Therefore, such situation may occur that loads in plural motors 
are totally excessive even load in each motor is not excessive. 
For this situation, a load absorbing operation for the entire body 
is considered to be required, separately from the load absorbing 
operation for each motor. 

Therefore, in the robot 1 of this embodiment, in parallel to 
execution of absorbing a static and dynamic load torque in each 
actuator motor, it is monitored whether loads in two or more 
motors are totally excessive. As a result, it can be detected 
whether a prescribed part such as arms and legs or the entire body 
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is in an overload state or not, even each motor is not in an 
overload state. 

When it is detected that loads in a plurality of motors are 
totally excessive, not the load absorbing operation for each motor 
but the body protection operation to eliminate the overload state 
of the entire body is performed. The body protection operation 
here includes cutoff of power to relevant motors or all motors of 
the body and weakening of the relevant motors or all motors of the 
body. The weakening of a motor is realized by setting a generated 
torque to zero or decreasing a viscosity resistance of a motor by 
gain adjustment. 

For example, Fig. 2 8 shows a situation where the robot 1 is 
trying to stand up. However, the robot's leg touches an obstacle 
and if the robot 1 keeps on standing up, reactive forces are 
applied in directions shown by solid line arrows. As a result, 
loads are applied to the pitch of the right shoulder, the roll and 
pitch of the right thigh, and the pitch of the right ankle. In 
this case, the loads do not break any axis but may cause plastic 
deformation in a frame of the body or damage of its cover. 

In order to detect such situation, each current for 
consuming the actuator load in each axis in a joint is detected 
and all currents are summed up in a higher-ranked control system 
and the total current is monitored as total load in the entire 
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body . 

Specifically, a load torque T in each axis of a motor is 
derived from a product of K v ± and V± from equation (7), that is, 
the torque is monitored based on a voltage applied to the motor. 
Therefore, the total T sum of load torques in the entire body is 
derived as follows: 



24 




Where k-numbered actuator is A k (note that, l^k^24) and its load 
torque is T k . 

In a case where the robot 1 stands up as shown in Fig. 28, 
large load is applied to the actuators A 5 , A9 of the pitch axes of 
the right and left shoulder joints, the actuators A i4 , A 20 of the 
roll axes of the right and left hip joints, the actuators Ai 5 , A 2 i 
of the pitch axes of the hip joints, and the actuators A i7 , A23 of 
the roll axes of the right and left ankle joints, and the total 
load torque T sum is derived as follows: 



T = 



= lk Tk ~ {T " 



5 +r 9 +r 14 +r 20 +r 15 +r 21 +r 17 +r 23 ) + o(r,) 



(ID 
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In this equation, the total load torque in the other joint 
actuators 0(T k ) can be ignored. 

When the total load torque T 8um exceeds a prescribed 
threshold value for a prescribed period of time, the body 
protection operation such as shutdown is carried out in order to 
avoid breakage of the body. 

Fig. 29 shows a flowchart for detection of a shock load and 
constant load in each axis of a actuator motor, the detection of 
overloads in multiple axes, and the body protection operation in 
response to detection of the above loads. 

At step SI, it is detected from the evaluation function f (t) 
of equation (6) whether shock load which may cause damage is 
applied to a joint single axis. 

When it is detected that shock load has been applied to an 
actuator, the load absorbing mechanism in the actuator operates in 
order to avoid the overload state at step S2. More specifically, 
the arithmetic processing unit 90 of the control IC 80 performs 
the load absorbing processing procedure RT2 shown in Fig. 26, in 
order to perform the PWM control on the motor current I R1 so that 
the evaluation function f(t) does not exceed the second threshold 
value SH2 . 

Then, the arithmetic processing unit 90 informs the 
middleware layer controlling the robot's motion of the execution 
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of the load absorbing process at step S3. 

When the overload state can be avoided at step S4, a 
recovery process for the robot's position and condition is carried 
out at step S5. 

Fig. 30 schematically shows an operation on software for 
performing the load absorbing operation and recovery operation 
when shock load is applied to an actuator. 

When it is detected that shock load has been applied to an 
actuator (SI), the load absorbing mechanism (see Fig. 26) in the 
actuator operates, where the motor current is PWM-controlled to 
adjust the viscosity coefficient of the motor in order to avoid 
the overload state (S2). Then, the arithmetic processing unit 90 
in the actuator informs the higher-ranked software, that is, the 
middleware layer of the operation of the load absorbing mechanism 
(S3). When the middleware layer determines that the overload 
state can be avoided (S4), it allows the actuator to perform 
control (S5). The actuator side carries out a position/condition 
recovery process and returns the viscosity coefficient of the 
motor to the original value. 

Referring back to Fig. 29, it is determined based on the 
equation (2) whether a constant load which may cause damage has 
been applied to a joint single axis (step S6). When it is 
determined the constant load has been applied to an actuator, the 
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arithmetic processing unit 90 in the actuator informs the 
middleware layer (see Fig. 8) controlling the robot's motion of 
the overload state (step S7). 

The middleware layer instructs to decrease a servo gain of 
the actuator motor, in response to the notification (step S8). 

When the overload state can be avoided (step S4 ) , the 
position/condition recovery process is carried out (step S5). 

Fig. 31 schematically shows an operation on software for 
performing the load absorbing operation and recovery operation 
when constant load is applied to an actuator. 

When it is detected that constant load has been applied to 
an actuator (S6), the higher-ranked software, that is, the 
middleware layer is informed of this matter (S7). The middleware 
layer instructs to decrease the servo gain of the actuator (S8). 
Then when it is determined that the overload state can be avoided 
(S4), it allows the actuator to perform control (S5). The 
actuator side performs the position/condition recovery process to 
return the servo gain of the motor to the original value. 

Referring back to Fig. 29, it is determined based on the 
above equation (10) or (11) that two or more joints totally come 
into the overload state at the same time due to loads (step S9). 

Like the situation shown in Fig. 26, when an overload state 
is detected, the body protection module is informed of this state 
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via the operation control system of the middleware layer (step 
S10), to carry out the body protection operation (step Sll). 

Fig, 32 schematically shows the structure of the middleware 
layer to detect an overload state in a plurality of joint axes as 
a whole and perform the body protection operation. As shown in 
this figure, the load monitoring module and the body protection 
module are arranged in this middleware layer. 

The load monitoring module concurrently receives information 
on a load state (for example, a voltage value Vi corresponding to 
a load torque) from the actuator motors Ai to A 24/ and detect a 
load state in the entire body based on the total of the values. 

The body protection module carries out the body protection 
operation when the load monitoring module detects the overload 
state. For example, the body protection module shuts off power of 
the actuator motors of the all body or relevant parts and weakens 
the joints. 

Fig. 33 schematically shows an operation on software to 
perform the load absorbing operation and the recovery operation 
when loads in a plurality of joint axes are totally excessive. 

In the middleware layer, the load monitoring module detects 
an overload state in a plurality of joint axes (S9), it informs 
the body protection module of this state (Sll). The body 
protection module carries out the body protection operation (Sll). 
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For example, it shuts off power to the actuator motors of the all 
body or to relevant parts and weakens the joints. 

This invention is not limited to a "robot" . That is, this 
application can be applied to mechanical apparatuses which use 
electric or magnetic functions to move like humans, or even to 
moving apparatuses in other industrial fields, like toys. 

Further, this invention is applied to a two-legged walking 
type robot 1 in Fig. 1 to Fig. 5. This invention, however, is not 
limited to this and can be widely applied to, in addition to 
robots, other apparatuses having servo motors as power sources for 
moving parts . 

Still further, this invention has described a case where a 
torque measuring means for calculating a sum of absolute values of 
a static load torque newly applied to a link connected to the 
output shaft 75 of an actuator Ai to A 2 4 and the generated torque 
of the actuator Ai to A 2 4 and a load absorbing control means for 
controlling the motor so as to reduce the generated torque when 
the sum exceeds the prescribed first threshold value are realized 
by the control IC 80 for controlling the position of the actuator 
Ai to A 2 4 based on the operation command COM from the higher-ranked 
controller. This invention, however, is not limited to this and 
these means can be provided, separately from the control IC 80. 

Still further, this invention has described a case where an 
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energy measuring means for detecting the variation of energy of a 
dynamic load torque applied to a link connected to the output 
shaft 75 of an actuator Ai to A 2 4 and a load absorbing control 
means for controlling the motor so as to reduce the generated 
torque when the variation of energy detected by the energy 
measuring means exceeds the prescribed second threshold value are 
realized by the control IC 80. However, this invention is not 
limited to this and these means can be provided, separately from 
the control IC 80. 

Still further, this invention has described a case where the 
proportionality constants K± and K e in the equation (9) are set to 
1.0 and 4.0, respectively, and the second threshold value SH2 is 
set to a value between 1.3 and 4.0 mN-m*rad/S2 which is considered 
optimal. This invention, however, is not limited to this and 
these proportionality constants K ± , K e and the second threshold 
value SH2 can be set to other values according to the construction 
of a corresponding actuator. * 

Still further, this invention has described a case where 
current I R i flowing in the power line LIN for the drive circuit 81 
is detected as a voltage Vi and the variations of energy of the 
static and dynamic load torques applied to a link connected to the 
output shaft 75 of an actuator Ai to A 2 4 are detected based on the 
detected voltage Vi. This invention, however, is not limited to 
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this and not the current I R i but another thing can be used, 
provided that the variations of energy of the static and dynamic 
load torques can be correctly obtained based on it. 

While there has been described in connection with the 
preferred embodiments of the invention, it will be obvious to 
those skilled in the art that various changes and modifications 
may be aimed, therefore, to cover in the appended claims all such 
changes and modifications as fall within the true spirit and scope 
of the invention. 
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